/*-
 * Copyright (c) 1990, 1993
 *    The Regents of the University of California.  All rights reserved.
 *
 * This code is derived from software contributed to Berkeley by
 * Chris Torek.
 *
 * Portions copyright (c) 1999, 2000
 * Intel Corporation.
 * All rights reserved.
 * 
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 * 
 *    This product includes software developed by the University of
 *    California, Berkeley, Intel Corporation, and its contributors.
 * 
 * 4. Neither the name of University, Intel Corporation, or their respective
 *    contributors may be used to endorse or promote products derived from
 *    this software without specific prior written permission.
 * 
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS, INTEL CORPORATION AND
 * CONTRIBUTORS ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING,
 * BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS,
 * INTEL CORPORATION OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 */

// wide character version
// efi/lib/libc/wchar/vfwscanf.c


#include <wchar.h>
#include <stdio.h>
#include <stdlib.h>
#include <wctype.h>
#if __STDC__
#include <stdarg.h>
#else
#include <varargs.h>
#endif
#include <string.h>

#include "../locale/collate.h"
#include "../stdio/local.h"

#define FLOATING_POINT

#include "../stdio/floatio.h"
#include <libc_debug.h>

/*
 * character width based macros
 */
#define    CharType             wchar_t
#define    BufferFill(x)        __swrefill(x)
#define    _svfscanfEntryPoint  __svfwscanf
#define	   StrToLong            wcstol
#define	   StrToULong           wcstoul
#define	   StrToQuad			wcstoq
#define	   StrToUQuad			wcstouq
#define    MemorySet			wmemset
#define    UnGetChar            ungetwc
#define	   IsWhiteSpace		    iswspace	
#define	   IsUpperCase          iswupper	
#define    _C(x)               L ## x

/***************************************************************************
 *
 *   With the about character width based macros, the remaining code should
 *   be common to both Unicode and ASCII versions.
 *
 ***************************************************************************/

/*
 * Flags used during conversion.
 */
#define    LONG        0x01    /* l: long or double */
#define    LONGDBL     0x02    /* L: long double */
#define    SHORT       0x04    /* h: short */
#define    SUPPRESS    0x08    /* suppress assignment */
#define    POINTER     0x10    /* weird %p pointer (`fake hex') */
#define    NOSKIP      0x20    /* do not skip blanks */
#define    QUAD        0x400

/*
 * The following are used in numeric conversions only:
 * SIGNOK, NDIGITS, DPTOK, and EXPOK are for floating point;
 * SIGNOK, NDIGITS, PFXOK, and NZDIGITS are for integral.
 */
#define    SIGNOK      0x40    /* +/- is (still) legal */
#define    NDIGITS     0x80    /* no digits detected */

#define    DPTOK       0x100   /* (float) decimal point is still legal */
#define    EXPOK       0x200   /* (float) exponent (e+3, etc) still legal */

#define    PFXOK       0x100   /* 0x prefix is (still) legal */
#define    NZDIGITS    0x200   /* no zero digits detected */

/*
 * Conversion types.
 */
#define    CT_CHAR     0    /* %c conversion */
#define    CT_CCL      1    /* %[...] conversion */
#define    CT_STRING   2    /* %s conversion */
#define    CT_INT      3    /* integer, i.e., strtoq or strtouq */
#define    CT_FLOAT    4    /* floating, i.e., strtod */


#define    CharSize        sizeof(CharType)
#define    BuffEmpty(x)    ((x)->_r < CharSize)
#define    DerefChar(x)    (*(CharType*)((x)->_p))
#define    NextChar(x)     (x)->_r -= CharSize, (x)->_p += CharSize
#define    IsEof(x)        (BuffEmpty(x) && BufferFill(x))

#define    BUF         513    /* Maximum length of numeric string. */

static CharType *__sccl(CharType *, CharType *);

/*
 * vfwscanf
 */
int
_svfscanfEntryPoint(fp, fmt0, ap)
    register FILE *fp;
    CharType const *fmt0;
    va_list ap;
{
    register CharType *fmt = (CharType *)fmt0;
    register wint_t c;        /* character from format, or conversion */
    register size_t width;    /* field width, or 0 */
    register CharType *p;     /* points into all kinds of strings */
    register int n;           /* handy integer */
    register int flags;       /* flags as defined above */
    register CharType *p0;    /* saves original value of p when necessary */
    int nassigned;            /* number of fields assigned */
    int nconversions;         /* number of conversions */
    int nread;                /* number of characters consumed from fp */
    int base;                 /* base argument to StrToXXX functions */
    u_quad_t(*ccfn)();        /* conversion function (StrToXXX) */
    CharType ccltab[256];     /* character class table for %[...] */
    CharType buf[BUF];        /* buffer for numeric conversions */

    /* `basefix' is used to avoid `if' tests in the integer scanner */
    static short basefix[17] =
        { 10, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16 };

    nassigned = 0;
    nconversions = 0;
    nread = 0;
    base = 0;        /* XXX just to keep gcc happy */
    ccfn = NULL;     /* XXX just to keep gcc happy */    
    for (;;) {
        c = *fmt++;
        if (c == 0)
            return (nassigned);
        if (IsWhiteSpace(c)) {
            while (!IsEof(fp) && IsWhiteSpace(DerefChar(fp)))
                nread++, NextChar(fp);
            continue;
        }

        if (c != _C('%'))
            goto literal;
        width = 0;
        flags = 0;
        /*
         * switch on the format.  continue if done;
         * break once format type is derived.
         */
again:        c = *fmt++;
        switch (c) {
        case _C('%'):
literal:
            if (IsEof(fp))
                goto input_failure;
            if (DerefChar(fp) != c)
                goto match_failure;
            NextChar(fp);
            nread++;
            continue;

        case _C('*'):
            flags |= SUPPRESS;
            goto again;
        case _C('l'):
            flags |= LONG;
            goto again;
        case _C('q'):
            flags |= QUAD;
            goto again;
        case _C('L'):
            flags |= LONGDBL;
            goto again;
        case _C('h'):
            flags |= SHORT;
            goto again;

        case _C('0'): case _C('1'): case _C('2'): case _C('3'): case _C('4'):
        case _C('5'): case _C('6'): case _C('7'): case _C('8'): case _C('9'):
            width = width * 10 + c - _C('0');
            goto again;

        /*
         * Conversions.
         * Those marked `compat' are for 4.[123]BSD compatibility.
         *
         * (According to ANSI, E and X formats are supposed
         * to the same as e and x.  Sorry about that.)
         */
        case _C('D'):    /* compat */
            flags |= LONG;
            /* FALLTHROUGH */
        case _C('d'):
            c = CT_INT;
            ccfn = (u_quad_t (*)())StrToQuad;
            base = 10;
            break;

        case _C('i'):
            c = CT_INT;
            ccfn = (u_quad_t (*)())StrToQuad;
            base = 0;
            break;

        case _C('O'):    /* compat */
            flags |= LONG;
            /* FALLTHROUGH */
        case _C('o'):
            c = CT_INT;
            ccfn = StrToUQuad;
            base = 8;
            break;

        case _C('u'):
            c = CT_INT;
            ccfn = StrToUQuad;
            base = 10;
            break;

        case _C('X'):    /* compat   XXX */
            flags |= LONG;
            /* FALLTHROUGH */
        case _C('x'):
            flags |= PFXOK;    /* enable 0x prefixing */
            c = CT_INT;
            ccfn = StrToUQuad;
            base = 16;
            break;

#ifdef FLOATING_POINT
        case _C('E'):    /* compat   XXX */
        case _C('F'):    /* compat */
            flags |= LONG;
            /* FALLTHROUGH */
        case _C('e'): case _C('f'): case _C('g'):
            c = CT_FLOAT;
            break;
#endif

        case _C('s'):
            c = CT_STRING;
            break;

        case _C('['):
            fmt = __sccl(ccltab, fmt);
            flags |= NOSKIP;
            c = CT_CCL;
            break;

        case _C('c'):
            flags |= NOSKIP;
            c = CT_CHAR;
            break;

        case _C('p'):    /* pointer format is like hex */
            flags |= POINTER | PFXOK;
            c = CT_INT;
            ccfn = StrToUQuad;
            base = 16;
            break;

        case _C('n'):
            nconversions++;
            if (flags & SUPPRESS)    /* ??? */
                continue;
            if (flags & SHORT)
                *va_arg(ap, short *) = nread;
            else if (flags & LONG)
                *va_arg(ap, long *) = nread;
            else if (flags & QUAD)
                *va_arg(ap, quad_t *) = nread;
            else
                *va_arg(ap, int *) = nread;
            continue;

        /*
         * Disgusting backwards compatibility hacks.    XXX
         */
        case _C('\0'):    /* compat */
            return (EOF);

        default:    /* compat */
            if (IsUpperCase(c))
                flags |= LONG;
            c = CT_INT;
            ccfn = (u_quad_t (*)())StrToQuad;
            base = 10;
            break;
        }

        /*
         * We have a conversion that requires input.
         */
        if (IsEof(fp))
            goto input_failure;

        /*
         * Consume leading white space, except for formats
         * that suppress this.
         */
        if ((flags & NOSKIP) == 0) {
            while (IsWhiteSpace(DerefChar(fp))) {
                nread++;
                fp->_r -= CharSize;
                if (fp->_r >= CharSize)
                    fp->_p += CharSize;
                else if (BufferFill(fp))
                    goto input_failure;
            }
            /*
             * Note that there is at least one character in
             * the buffer, so conversions that do not set NOSKIP
             * ca no longer result in an input failure.
             */
        }

        /*
         * Do the conversion.
         */
        switch (c) {

        case CT_CHAR: /* %c */
            /* scan arbitrary characters (sets NOSKIP) */
            if (width == 0)
                width = 1;
            if (flags & SUPPRESS) {
                size_t sum = 0;
                for (;;) {
                    if ((size_t)(n = (fp->_r / CharSize)) < width) {
                        sum += n;
                        width -= n;
                        fp->_p += (n * CharSize);
                        if (BufferFill(fp)) {
                            if (sum == 0)
                                goto input_failure;
                            break;
                        }
                    } else {
                        sum += width;
                        fp->_r -= (int)(width * CharSize);
                        fp->_p += (width * CharSize);
                        break;
                    }
                }
                nread += (int)sum;
            } else {
                size_t r = fread((void *)va_arg(ap, char *), 1,
                    (width * CharSize), fp);
                if (r == 0)
                    goto input_failure;
                nread += (int)(r / CharSize);
                nassigned++;
            }
            nconversions++;
            break;

        case CT_CCL:  /* %[...] */
            /* scan a (nonempty) character class (sets NOSKIP) */
            if (width == 0)
                width = (size_t)~0;    /* `infinity' */
            /* take only those things in the class */
            if ( flags & SUPPRESS ) {
                n = 0;
                while ( ccltab[DerefChar(fp)] ) {
                    n++, NextChar(fp);
                    if (--width == 0)
                        break;
                    if (IsEof(fp)) {
                        if (n == 0)
                            goto input_failure;
                        break;
                    }
                }
                if ( n == 0 )
                    goto match_failure;
            } else {
                p0 = p = va_arg( ap, CharType * );
                while ( ccltab[DerefChar(fp)] ) {
                    *p++ = DerefChar(fp);
					NextChar(fp);
                    if (--width == 0)
                        break;
                    if (IsEof(fp)) {
                        if (p == p0)
                            goto input_failure;
                        break;
                    }
                }
                n = (int)(p - p0) ;
                if (n == 0)
                    goto match_failure ;
                *p = 0 ;
                nassigned++ ;
            }
            nread += n;
            nconversions++;
            break;

        case CT_STRING: /* %s */
            /* like CCL, but zero-length string OK, & no NOSKIP */
            if (width == 0)
                width = (size_t)~0;
            if (flags & SUPPRESS) {
                n = 0;
                while (!IsWhiteSpace(DerefChar(fp))) {
                    n++, NextChar(fp);
                    if (--width == 0)
                        break ;
                    if (IsEof(fp))
                        break;
                }
                nread += n;
            } else {
                p0 = p = va_arg(ap, CharType *);
                while (!IsWhiteSpace(DerefChar(fp))) {
                    *p++ = DerefChar(fp);
					NextChar(fp);
                    nread++;
                    if (--width == 0)
                        break;
                    if (IsEof(fp))
                        break;
                }
                *p = 0 ;
                nassigned++;
            }
            nconversions++;
            continue;

        case CT_INT:  /* %d and friends */
            /* scan an integer as if by strtoq/strtouq */
#ifdef hardway
            if (width == 0 || width > sizeof(buf)/CharSize - 1)
                width = sizeof(buf)/CharSize - 1;
#else
            /* size_t is unsigned, hence this optimisation */
            if (--width > sizeof(buf)/CharSize - 2)
                width = sizeof(buf)/CharSize - 2;
            width++;
#endif
            flags |= SIGNOK | NDIGITS | NZDIGITS;
            for (p = buf; width; width--) {
                c = DerefChar(fp);

                /*
                 * Switch on the character; `goto ok'
                 * if we accept it as a part of number.
                 */
                switch (c) {

                /*
                 * The digit 0 is always legal, but is
                 * special.  For %i conversions, if no
                 * digits (zero or nonzero) have been
                 * scanned (only signs), we will have
                 * base==0.  In that case, we should set
                 * it to 8 and enable 0x prefixing.
                 * Also, if we have not scanned zero digits
                 * before this, do not turn off prefixing
                 * (someone else will turn it off if we
                 * have scanned any nonzero digits).
                 */
                case _C('0'):
                    if (base == 0) {
                        base = 8;
                        flags |= PFXOK;
                    }
                    if (flags & NZDIGITS)
                        flags &= ~(SIGNOK|NZDIGITS|NDIGITS);
                    else
                        flags &= ~(SIGNOK|PFXOK|NDIGITS);
                    goto ok;

                /* 1 through 7 always legal */
                case _C('1'): case _C('2'): case _C('3'):
                case _C('4'): case _C('5'): case _C('6'): case _C('7'):
                    base = basefix[base];
                    flags &= ~(SIGNOK | PFXOK | NDIGITS);
                    goto ok;

                /* digits 8 and 9 ok iff decimal or hex */
                case _C('8'): case _C('9'):
                    base = basefix[base];
                    if (base <= 8)
                        break;    /* not legal here */
                    flags &= ~(SIGNOK | PFXOK | NDIGITS);
                    goto ok;

                /* letters ok iff hex */
                case _C('A'): case _C('B'): case _C('C'):
                case _C('D'): case _C('E'): case _C('F'):
                case _C('a'): case _C('b'): case _C('c'):
                case _C('d'): case _C('e'): case _C('f'):
                    /* no need to fix base here */
                    if (base <= 10)
                        break;    /* not legal here */
                    flags &= ~(SIGNOK | PFXOK | NDIGITS);
                    goto ok;

                /* sign ok only as first character */
                case '+': case '-':
                    if (flags & SIGNOK) {
                        flags &= ~SIGNOK;
                        goto ok;
                    }
                    break;

                /* x ok iff flag still set & 2nd char */
                case _C('x'): case _C('X'):
                    if (flags & PFXOK && p == buf + 1) {
                        base = 16;    /* if %i */
                        flags &= ~PFXOK;
                        goto ok;
                    }
                    break;
                }

                /*
                 * If we got here, c is not a legal character
                 * for a number.  Stop accumulating digits.
                 */
                break;
        ok:
                /*
                 * c is legal: store it and look at the next.
                 */
                *p++ = c;
                fp->_r -= CharSize;
                if (!BuffEmpty(fp))
                    fp->_p += CharSize;
                else if (BufferFill(fp))
                    break;        /* EOF */
            }
            /*
             * If we had only a sign, it is no good; push
             * back the sign.  If the number ends in `x',
             * it was [sign] '0' 'x', so push back the x
             * and treat it as [sign] '0'.
             */
            if (flags & NDIGITS) {
                if (p > buf)
                    (void) UnGetChar(*--p, fp);
                goto match_failure;
            }
            c = ((CharType *)p)[-1];
            if (c == _C('x') || c == _C('X')) {
                --p;
                (void) UnGetChar(c, fp);
            }
            if ((flags & SUPPRESS) == 0) {
                u_quad_t res;

                *p = 0;
                res = (*ccfn)(buf, (CharType **)NULL, base);
                if (flags & POINTER)
                    *va_arg(ap, void **) = (void *)res;
                else if (flags & SHORT)
                    *va_arg(ap, short *) = (short)res;
                else if (flags & LONG)
                    *va_arg(ap, long *) = (long)res;
                else if (flags & QUAD)
                    *va_arg(ap, quad_t *) = res;
                else
                    *va_arg(ap, int *) = (int)res;
                nassigned++;
            }
            nread += (int)((p - buf)/CharSize); /* cast from EFI port */
            nconversions++;
            break;

#ifdef FLOATING_POINT
        case CT_FLOAT:  /* %f and co. */
            /* scan a floating point number as if by strtod */
#ifdef hardway
            if (width == 0 || width > sizeof(buf)/CharSize - 1)
                width = sizeof(buf)/CharSize - 1;
#else
            /* size_t is unsigned, hence this optimisation */
            if (--width > sizeof(buf)/CharSize - 2)
                width = sizeof(buf)/CharSize - 2;
            width++;
#endif
            flags |= SIGNOK | NDIGITS | DPTOK | EXPOK;
            for (p = buf; width; width--) {
                c = DerefChar(fp);
                /*
                 * This code mimicks the integer conversion
                 * code, but is much simpler.
                 */
                switch (c) {

                case _C('0'): case _C('1'): case _C('2'): case _C('3'):
                case _C('4'): case _C('5'): case _C('6'): case _C('7'):
                case _C('8'): case _C('9'):
                    flags &= ~(SIGNOK | NDIGITS);
                    goto fok;

                case _C('+'): case _C('-'):
                    if (flags & SIGNOK) {
                        flags &= ~SIGNOK;
                        goto fok;
                    }
                    break;
                case _C('.'):
                    if (flags & DPTOK) {
                        flags &= ~(SIGNOK | DPTOK);
                        goto fok;
                    }
                    break;
                case _C('e'): case _C('E'):
                    /* no exponent without some digits */
                    if ((flags&(NDIGITS|EXPOK)) == EXPOK) {
                        flags =
                            (flags & ~(EXPOK|DPTOK)) |
                            SIGNOK | NDIGITS;
                        goto fok;
                    }
                    break;
                }
                break;
        fok:
                *p++ = c;
                fp->_r -= CharSize;
                if (!BuffEmpty(fp))
                    fp->_p += CharSize;
                else if (BufferFill(fp))
                    break;        /* EOF */
            }
            /*
             * If no digits, might be missing exponent digits
             * (just give back the exponent) or might be missing
             * regular digits, but had sign and/or decimal point.
             */
            if (flags & NDIGITS) {
                if (flags & EXPOK) {
                    /* no digits at all */
                    while (p > buf)
                        (void) UnGetChar(*--p, fp);
                    goto match_failure;
                }
                /* just a bad exponent (e and maybe sign) */
                c = *--p;
                if (c != _C('e') && c != _C('E')) {
                    (void) UnGetChar(c, fp);/* sign */
                    c = *--p;
                }
                (void) UnGetChar(c, fp);
            }
            if ((flags & SUPPRESS) == 0) {
                double res;

                *p = 0;
                /* XXX this loses precision for long doubles. */
                res = wcstod(buf, (CharType **) NULL);
                if (flags & LONGDBL)
                    *va_arg(ap, long double *) = res;
                else if (flags & LONG)
                    *va_arg(ap, double *) = res;
                else
                    *va_arg(ap, float *) = (float)res;
                nassigned++;
            }
            nread += (int)((p - buf)/CharSize); /* cast from EFI port */
            nconversions++;
            break;
#endif /* FLOATING_POINT */
        }
    }
input_failure:
    return (nconversions != 0 ? nassigned : EOF);
match_failure:
    return (nassigned);
}

/*
 * Fill in the given table from the scanset at the given format
 * (just after `[').  Return a pointer to the character past the
 * closing `]'.  The table has a 1 wherever characters should be
 * considered part of the scanset.
 */
static CharType *
__sccl(tab, fmt)
    register CharType *tab;
    register CharType *fmt;
{
    register int c, n, v, i;

    /* first `clear' the whole table */
    c = *fmt++;        /* first char hat => negated scanset */
    if (c == _C('^')) {
        v = 1;        /* default => accept */
        c = *fmt++;    /* get new first char */
    } else
        v = 0;        /* default => reject */

    /* XXX: Will not work if sizeof(tab*) > sizeof(CharType) */
    (void) MemorySet((CharType*)tab, (CharType)v, 256);

    if (c == 0)
        return (fmt - 1);/* format ended before closing ] */

    /*
     * Now set the entries corresponding to the actual scanset
     * to the opposite of the above.
     *
     * The first character may be ']' (or '-') without being special;
     * the last character may be '-'.
     */
    v = 1 - v;
    for (;;) {
        tab[c] = v;        /* take character c */
doswitch:
        n = *fmt++;        /* and examine the next */
        switch (n) {

        case 0:            /* format ended too soon */
            return (fmt - 1);

        case _C('-'):
            /*
             * A scanset of the form
             *    [01+-]
             * is defined as `the digit 0, the digit 1,
             * the character +, the character -', but
             * the effect of a scanset such as
             *    [a-zA-Z0-9]
             * is implementation defined.  The V7 Unix
             * scanf treats `a-z' as `the letters a through
             * z', but treats `a-a' as `the letter a, the
             * character -, and the letter a'.
             *
             * For compatibility, the `-' is not considerd
             * to define a range if the character following
             * it is either a close bracket (required by ANSI)
             * or is not numerically greater than the character
             * we just stored in the table (c).
             */
            n = *fmt;
            if (n == _C(']')
                || (__collate_load_error ? n < c :
                __collate_range_cmp ((int)n, (int)c) < 0
                   )
               ) {
                c = _C('-');
                break;    /* resume the for(;;) */
            }
            fmt++;
            /* fill in the range */
            if (__collate_load_error) {
                do {
                    tab[++c] = v;
                } while (c < n);
            } else {
                for (i = 0; i < 256; i ++)
                    if (   __collate_range_cmp ((int)c, (int)i) < 0
                        && __collate_range_cmp ((int)i, (int)n) <= 0
                       )
                        tab[i] = v;
            }
#if 1    /* XXX another disgusting compatibility hack */
            c = n;
            /*
             * Alas, the V7 Unix scanf also treats formats
             * such as [a-c-e] as `the letters a through e'.
             * This too is permitted by the standard....
             */
            goto doswitch;
#else
            c = *fmt++;
            if (c == 0)
                return (fmt - 1);
            if (c == _C(']'))
                return (fmt);
#endif
            break;

        case _C(']'):        /* end of scanset */
            return (fmt);

        default:        /* just another character */
            c = n;
            break;
        }
    }
    /* NOTREACHED */
}
